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ABSTRACT 


The Naval Postgraduate School’s Small Robotic Technology (SMART) Initiative 
is an ongoing research effort within the Combat Systems Science and Technology 
Curriculum that engages in forward-looking applications of small robotic technology for 
military employment. The goal of the program is to develop a multipurpose robotic 
platform that is capable of hosting varied sensor packages for military research. This 
thesis successfully modified a Foster Miller Lemming tracked vehicle: Payload volume 
was increased to allow for ease of systems testing and access while incorporating a 
method for deploying varied sensor modules on a towed sled. Original micro-controller 
hardware has been replaced with a COTS system that allowed for simplified interfacing 
with a Honeywell digital compass ad a Motorola G.P.S. card. Communications with the 
Robot were provided through the Internet via a modem. A control interface for use on a 
personal computer was implemented by creating a JAVA application; the control 
interface has also been converted to a JAVA applet that the Robot is capable of 
downloading to a user via a web interface. Follow on research will fully integrate the 
Robot with a variety of sensor packages including a synthetic array seismic sonar, visual 


and infrared devices and chemical detection devices. 
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I. INTRODUCTION 


A. WHY ROBOTICS? 


Since the time of Robby the Robot in “Forbidden Planet’, man has dreamed of 
using the mastery of technology to assist him with the toils of daily life. Since robots 
don’t require food or water, since they don’t complain, and because they are inexpensive 
and expendable, they seem to be a good fit for the routine, stealthy, environmentally 
hazardous (chemical, biological and radioactive) and dangerous tasks usually delegated 


to humans. 


Today, robots are used throughout the spectrum of military conflict. Modern 
examples include de-mining operations in Kosovo and _ Surveillance flights over 
Afghanistan. Projections for future uses include urban surveillance, scout missions from 
the sea, and chemical-biological hazard area detection. 


1. Force Multiplication/Casualty Reduction 


Robots can be used to greatly increase the combat effectiveness of the individual 
soldier. For example, a robotic sensing platform will allow the soldier to observe the 
battle-space with senses he does not naturally have. This could include infrared, ultra- 
violet and enhanced acoustics sensors. Additionally, the expendability of the robot will 
allow the soldier to expand the location of his senses to places where personal 
surveillance would be too dangerous. The result is the ability to maintain battlefield 
superiority while placing fewer and fewer forces in harms way. 

2. Military Operations Other Than War (MOOTW) Missions: 


a. Surveillance 


The ability of a robot to conduct covert surveillance will perform a major 
role in the reduction of casualties in war. Although it is doubtful that a robot would 
eliminate the need for manned surveillance of prospective points of an invasion, robotic 
surveys could help to identify and eliminate candidate locations before lives are lost in 
efforts to survey heavily mined or defended locations. As shown in figure 1, a sea 
launched crawler could covertly swim ashore using a variety of sensors to detect the 
presence of buried mines, spot hidden bunkers and then relay information to nearby 


1 


launch platforms. The conceived surveillance mission could either continue until the 


robot runs out of power or returns to the launch platform. 


Robot 
Launch 


Travers 
Surf Zone 
Short 


Range 


Looker 





Figure 1. Conceptual Autonomous Robotic Mine Reconnaissance Mission. 
[From Ref. 25] 


b. Mine detection and removal/Explosives Ordinance Disposal. 


The utility of a robotic platform is clearly obvious in the tasks of explosive 
ordinance disposal and mine detection. The Talon robot built by the Foster-Miller 
Company is used in the diffusing of mines and unexploded ordinance. The robot uses a 
two-way RF link providing video and operator manipulability of the control arm. During 


operations in Bosnia the Talon received extensive use and received generally high marks. 


Mine detection schemes for use with robotic platforms vary from the use 
of simple metal detectors for the detection of buried metallic mines to the current NPS 


project of deploying a towed Seismo- Acoustic sonar behind a robotic platform. 





Figure 2. Talon (Foster-Miller) [From Ref. 9] 


SMART VISION 


e Create an ongoing research effort within the CSS&T Curriculum that 
engages in a forward looking application of Small Robotic Technology for 
Military Employment 


e Develop a Multipurpose Robotic Platform capable of hosting varied 


sensor packages. 


The specific goals accomplished during this thesis research included: 


The successful operational demonstration of a lemming tracked vehicle in 
manual and autonomous modes. 

The unique integration of diverse COTS components into a single operational 
platform. 

The successful programming and integration of a GPS and digital compass 
navigation system. 

The smooth interface between the microprocessor and the platform motors 
using a self designed PWM motor control circuit and COTS electronic speed 
control units. 

The establishment of wireless networking for communications using TCP/IP 
socket connections. 

The creation of a user friendly GUI using a JAVA application and the 
subsequent conversion of this GUI to a downloadable JAVA applet. 


1. Platform 


a. Current 


The SMART platform is a modified Foster-Miller Lemming. The 
computing, sensing and communication elements have been removed and replaced with 
configurable and programmable COTS equipment. An electronics enclosure was added to 
increase the available area for components. It also acts as a base designed to interface 
with modular sensor units. While the current platform operates at only a walking pace 
and has a large vibration and noise signature due to its metallic gearing, future iterations 
of the platform will include motor and gearing options to enhance performance as well as 


belt drives to reduce inherent vibrations and noise. 





Figure 3. Bender in a developmental stage 


b. Communication 


Communication with the SMART robot is handled via an_ internet 
interface using sockets and IP addressing. A client JAVA application establishes sockets 
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for use in the transmittance and receipt of information. Future plans for a WEB interface 
will eventually allow remote operators to control the platform from a secure location via 
a standard web browser. 


c. Basic Operation 


The heart of the SMART platform is the “ALLTASK.C” program, which 
is compiled to the BL2000 microprocessor. The program communicates with the client 
JAVA control application via a standard wireless Ethernet link. Rs-232 serial channels on 
the BL2000 are used to communicate with the onboard GPS and Digital Compass. Both 


devices provide position and heading up-dates once per second. 


Movement commands, which include speed, course and GPS waypoint 
positions, are initiated via the client Java application and are sent to the robot as Ethernet 
packets over a_ wireless connection. The BL2000 microprocessor interprets these 


commands and, in turn, drives the plant (motors) via a Pulse Width Modulator (PWM). 


Remaining digital I/O and serial ports on the BL2000 are reserved for 
future expansion of the basic platform and communications with future sensor arrays. 


(See figure 4.) 
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Figure 4. Block Diagram 





d. Sensors: 


The current sensor project for the SMART robot is the Seismo- Acoustic 
sonar under development by a group in the CSS&T curriculum under the supervision of 
Dr Thomas Muir. This sonar generates and exploits Rayleigh wave phenomena, which 
propagates outward from the signal source and remains near the surface. Sophisticated 
signal analysis and filtering techniques make this sonar a good fit for the detection of 


buried mines in the surf- zone. 


The towed platform (Figure 5.) is the transmission portion of the Seismo- 
Acoustic sonar. A microprocessor creates the desired output waveform that is amplified 
by the acoustic amplifier on the forward end of the towed unit. The amplified signal is 
then fed into a series of acoustic “thumpers” which are located in the aluminum cylinder 
at the rear of the towed unit. The cylinder was chosen as a vehicle for the thumpers 
because it allows the maximum surface contact area (and therefore maximum energy 
transfer) with the ground while allowing a platform that the robot would be able to tow. 
Seismometers will either be placed onboard the thumper unit or deployed by a separate 


platform. 





Figure 5. Seismic Sonar 
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Il. OPERATIONAL SPECIFICATIONS 


A. COMMUNICATIONS RANGE 


An operational test of the communications range of the SMART robot showed 
satisfactory results when compared to the advertised range of the Ethernet modems 
employed. In an operational test at the Navy beach in Monterey CA generated a line of 
sight communications range of over 200m. When the robot was driven over a hill beyond 
the line of sight communications was lost at a range of 150m. Further tests at the NPS 
softball field showed a line of sight communications range of over 100m and additional 
testing will be completed to determine the actual maximum range. 


B. ENDURANCE 


Run time operational tests were performed to determine the endurance of the 
SMART platform with its current battery configuration. The communications system 
and the microprocessor are powered by a single 12-volt 3.0 AH battery and the endurance 
in operational tests was three to four hours. A 6-volt 1.3AH battery powers the compass 
and GPS cards and the endurance for the power supply was tested to be over 4 hours. 
The motors for the SMART robot are powered by a 12-volt battery that will last 2-4 
hours depending on the terrain and operational tempo. Field operational tests were 
limited by the battery endurance of the laptop computer, which limited field operations to 
approximately 2-3 hours. 

C. HEADING ACCURACY 


As a check of the heading accuracy of the compass guidance functionality of the 
SMART platform two tests were completed. The first test was a swing-check of the 
compass conducted with the robot under static conditions in a controlled environment. A 
reference line of OOO° magnetic was placed on the classroom floor and compass rose 
points were drawn in reference to this mark. The direction of magnetic north was 
determined with a generic magnetic compass. The robot was then aligned with the points 
and the readout from the onboard magnetic compass was read with the motors off and 
operating in all combinations. Results are specified in Table 1, and reflect an accuracy of 


pod be 


Actual Stop Forward Reverse Left Reverse 
Heading 





Table 1. | Compass Swing Check. 


Additional tests of heading accuracy were conducted in the field at the Navy 
beach in Monterey CA and at the softball field on NPS. Accounting for initial 
corrections made by the platform as it found its desired headings, all tests showed an 
operational heading accuracy of +10°. 


D. GPS ACCURACY 


Multiple test runs were conducted at the softball field at NPS with encouraging 
results. The GPS card on the SMART platform was operating without differential 
antennae installed and in that configuration; the rated accuracy of the card is only 100m. 
During a series of tests heading towards a common waypoint from various distances and 
directions the robot was able to accurately navigate 0 within 15m of the desired location. 
Given that the robot was programmed to stop navigating when it was within 5m of the 
waypoint and the accuracy of the card was 100m a repeatable accuracy of 15m was 
acceptable. Future iterations of the SMART platform will employ a differential antennae 


and increased accuracy is expected. 
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Il, HARDWARE 


As PLATFORM 

1. Foster-Miller Lemming 

The Foster-Miller Corporation has been building the Lemming robot platform for 
many years and the basic design plan is to ‘develop light, sturdy, compact robots that can 
be adapted for ordnance removal, reconnaissance, communication, relays, sensing and 
security’ [Ref 5]. The NPS SMART robot is an older generation Lemming received from 
Coastal Systems Station (CSS) Naval research facility in Panama City, Florida. Upon 
receipt at NPS the existing control hardware was removed and the focus of this thesis is 


the integration of the new COTS component based control system. 





Figure 6. Bender 
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2. Electronics Enclosures 
a. The Platform 


The platform enclosure was built to allow for ease of access during the 
initial program development and hardware integration phase. The platform is constructed 
of clear plastic that is approximately 0.325in thick. The platform places an 8.75in wide, 
13.5in long platform 3.5in above the base allowing for two large placement areas that 
could be visible during all aspects of testing. 

b. The Box 


The box electronics enclosure was constructed for use as_ splash-proof 
protective enclosure, which would also act as a base for the tow hitch used with the 
Seismo-acoustic sensor trailer. The box is 6.5in tall, 6in wide and 10.25in long, 
providing sufficient space for all electronics. Electronics are mounted to the floor or 
walls of the box by mounting screws (if provided) or Velcro. A mast was added the top 
of the tow hitch as a mounting location for the magnetic compass, the mast places the 
compass 27in above the main base of the Lemming and is high enough to eliminate 
magnetic interference from the motors and the GPS antenna which has a built in magnet 


used for mounting on automobile or marine applications. 
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3. Measured Figures 


Electronics box 
Length: 10.25in. 


——————— 









Electronics box 
Height: 6.5in. 


Height Ground 
to Track Top: 









Main Body Height: 3.5 in. 


Ground Clearance: 1.5 in. 


SS — SS —{[—_——sSs SP 


7 in. 


Wheel Diameter Vehicle Length (track to track) 20 in. 
(without track): 
6.5 in. 

Figure 7. SMART Platform side view (+ 0.25 in.). 
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Body Length: 15.5 in. 


Track Width: 
|) Wheel With 0.5 in. [ 3.5 in. 


Power 

mae Motor Box 
uPP y Battery Compartment Width: 5 in 

Switch Body Width: 8.5 in. 

Box 





Figure 8. SMART Platform Main Body Top View (+ 0.25 in.). 
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B. MICROPROCESSOR 
1. Z-WORLD BL2000 


The BL2000 microprocessor is a  many-functioned extremely capable 
microprocessor clearly designed with both the student and serious computer user in mind. 
Superior documentation and excellent customer support made the integration of Internet 
communications, serving a web page, multiple digital inputs; analog outputs and a 
cooperative multitasking control program a manageable task. The BL2000 can be 
powered with between nine and forty volts and in this application shares a battery with 
the communications modem. The development kit for the microprocessor contains a 


sturdy plastic protective case, which is used as a mounting device. 


Operating Language: Dynamic C 
22.1 MHz 
128K static RAM and 256K flash memory 
28 Digital I/O pins 


9 12 bit A/D converters 
2 12 bit D/A converters 
10Base-T Ethernet Port 
4 Serial Ports 
Real time clock 
E-mail and Web server capabilities 
Table 2. BL2000 Features 
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Figure 9. BL2000 (Z- World) [From Ref. 8] 


C. G.P.S 
1. Motorola M12 


The Motorola M12 GPS card is designed for use in either automotive or marine 
applications. The card utilizes a 6VDC input and provides a standard serial port output. 
A powered antenna is provided with a built-in magnetic base for ease of mounting on 
automotive or marine applications. The accuracy of the GPS card is 100m without a 
differential antenna but with a differential antenna an accuracy of 1-5m can be expected. 
The output from the card is fully programmable and can easily be changed to meet the 
users needs, the output string will always contain unneeded data about the status of the 
satellites tracked and the signal strength, this unneeded data is filtered out in the software 


and this process is covered in more detail later. 
The string is formatted as follows: 


@ @Eq,mm,dd,yy,ss,dd,mm.mmmm,n,dd,mm.mmmm,w,shhhhh.h,sss.s,hhh.h, 
m,t, dd.djnn,rrrr,aa, CCC<CR><LF>. 


¢ @@Eq >> Header 
e mm,dd,yy,ss >> Time stamp 


e § ddmm.mmmm >> Latitude 
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e n>> North or South 

e = =dd,mm.mmmm >> Longitude 

e w>> East or West 

e = shhhhh.h >> Height 

e sss.s >> Velocity 

e =hhh.h >> Heading 

e m,t,dd.drrrr,aa >> Receiver, Signal and Satellite Status 
e CCC >> Checksum 


The needed data from the GPS card is just the location portion of the data string that is 
highlighted in bold above. Additional data from the GPS card includes in order, a 
leading time stamp, height, velocity, heading, receiver status and a final checksum. The 
output rate from the card can be set to once per second as a maximum and down to once 


every 255 seconds. In our application it is set to update once per second. 


al is 


iT 


rinigiy 
midbisidbiak 


| 
| 
3 
a 
cat 
= 
z 
| 
Ey 


a 


li: > , 
= — | 





Figure 10. Motorola M12 [From Ref. 11] 
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D. DIGITAL COMPASS 
i Honeywell HMR3000 


The Honeywell HMR3000 is a small single card electronic compass unit capable 
of providing both heading and pitch information. The sensor on the compass is a 
magneto resistive sensor, which utilizes the anisotropic magneto resistance of the ferrous 
material of the sensor. The sensor material is placed in a basic wheat stone bridge 
configuration and the heading is calculated. The card utilizes a 6VDC input and provides 
a standard serial output to the user. The output is programmable to provide multiple 
signals including pitch, roll, heading, or any combination of these required in various 
formats. The output signal can be updated from six to three hundred times per minute 


and in our application is set to one update per second. 


Upon initial receipt the digital compass is programmed to provide a standardized 
output for marine applications. The standard is from the National Marine Electronics 
Association (NMEA) and is known as NMEA 0183. This standard programmed output is 
a string, containing heading, pitch and roll information. 


The string is formatted as follows: 
$PTNPHTR,HHH.H,N,P.P,N,R.R,N*2C. 
e $PTNPHR >> Header 
e HHH.H >> Heading 
e P.P>> Pitch 
e RR>> Roll 
e N->> Mode, N=normal 


The string is started with a standard header and is followed by the heading in degrees and 
tenths of degrees (HHH.H), the next character (N) indicates normal operation, followed 
by the pitch in degrees (P.P) finally followed by roll in degrees (R.R). Utilizing the 
provided interface program a message can be sent to the compass modifying its output. 
For our application, that string was parsed for the heading (HHH.H) ASCII information 
only. 
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Figure 11. Honeywell HMR3000 [From Ref. 10] 


E. COMMUNICATIONS 
1. Proxim RangeLAN2 7920 


The Proxim RangeLAN2 7920 is a COTS Ethernet LAN module. The unit is 
powered by 12 volts and has a current draw of less than one amp when transmitting. The 
7920 is self-configuring and will auto-negotiate network parameters upon power up .The 
7920 is capable of being either a master or a slave station to either another 7920 or a 
designated master station. The self-determining master or slave option allows the system 
to either work within the range of a LAN or set up its own LAN if being operated in the 
field. 


Communications between RangeLAN2 products is conducted in the 2.4GHz 
range utilizes frequency hopping and spread spectrum technology. The speed of data 
transfer is 1.6Mbps. The 7920 have a published range of 1000 feet and experiments with 
the system showed a range of 150m in a beach environment beyond line of sight. Line of 


sight maximum range in other environments has not yet been determined. 
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Figure 12. Proxim RangeLAN2 7920 


F. MOTOR CONTROL 
1. Pulse Width Modulation 


A pulse width modulation circuit is the standard for control of motors in the 
robotics field. 


a. Circuit 


The PWM control circuit designed for the SMART platform is constructed 
through the use of basic 555 timer chips. A basic PWM circuit can be found on the data 
sheet for National Semiconductors LM555 chip. The specific circuit designed for the 
SMART robot (Figure 13) uses a 555 timer to establish a base frequency. The base 
frequency and a control voltage provided from the analog outputs from the BL2000 are 
then fed into a 556 timer chip which performs the pulse width modulation function for 
the left and right motors. 


b. Calculations 


For the circuit in Figure 13 where Ry=10 kQ, Rg=1 kQ and C=1 uF. The 
frequency of the 555-timer output is determined by the charge and discharge time of the 
capacitor attached to the trigger and threshold inputs of the chip. The period (T) is 
determined by: 
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(1) T =1/f =0.693(R, +2R,)C 
The frequency (f) is given by: 
(2) T=l1/f 


For the pulse width modulation part of the circuit R=100 k2, C=0.047 uF V..=6V and 
Vin is determined by the output from the BL2000 digital to analog converters. The 
positive pulse width is given by: 


(3) T =-mn(1-V,,/V.,.)RC 


Frequency 


Stop Vin 


Stop Pulse Width 


Reverse Vin 


Rev Pulse Width 


Forward Vin 


Fwd Pulse Width 


120.25 Hz 


1.5V 


1.421msec 


1.0V 


0.898msec 


2.0V 


2.009msec 


Table 3. 


118Hz 


1.56V 


1.41 msec 


1.04V 


0.920msec 


2.05V 


2.05msec 


PWM Specifications 


118Hz 


1.56V 


1.41msec 


1.04V 


0.920msec 


2.05V 


2.05msec 





c. Schematic 


555 Timer Dual Pulse Width Modulator 






R100 kOhm < R100 kOhmn 






{0 kOhii 


BL2000 DAC 0 








Rb 4 kOhin 




















{0 kOhm 


—— O01uF — 4 uF 


























BL2000 DAC 1 








Left PWM Right PWM 
6 ) 


Figure 13. Pulse Width Modulator Schematic 


2. Motor Controllers 


a. Novak Super Rooster 


The Novak Super Rooster is a COTS Electronic Speed Control (ESC) 
used for competition radio control car racing. The ESC is capable of handling a twelve- 
volt power supply and can safely route 320 amps in the forward and 160 amps in the 


reverse direction while providing an impedance of only a few milliohms. With one touch 
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programming the ESC is quickly calibrated to the input signals provided and _ the 
calibration data is placed in permanent flash memory until the user reprograms the ESC. 
The ESC interprets the PWM supplied to it from the PWM circuit and converts the signal 


to the appropriate desired power supply to the motors. 


Part# 1860 





Figure 14. Novak Super Rooster [From Ref. 13] 
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IV. SOFTWARE 


A. OPERATIONAL THEORY 


The control mechanism for the SMART robotic platform depends upon a smooth 
interaction between two programs and the various threads running within these programs. 
The control interface for the SMART robot is a JAVA created GUI with sliders, 
pushbuttons and multiple interactive text fields. The program that actually controls the 
robot is a cooperative multitasking program in Dynamic C that interacts with both the 


JAVA application and the robot’s hardware package. 


Communication between the two programs is handled with standard TCP/IP 
sockets, (see figure 17). When a socket is established between two programs the 
programs are able to communicate by sending packets of information over the Internet. 
The JAVA and Dynamic C programs interact to establish five different sockets to 


perform various tasks. 


e The Motorsock socket is established to allow for direct control of the 
motors in a manual mode, this socket is established upon power up and is 


persistent until the robot is secured. 


e The Headsock and GPSsock sockets are established to facilitate the 
sending of data from the compass and GPS cards, these sockets are 


established when needed and are not persistent. 


e The DheadLocsock is established to allow the user to send a requested 
heading for movement or a GPS waypoint to drive to; this socket is also 


not persistent. 


e The Stopnavsocket is established to allow the user to manually stop the 
robot’s navigation process when desired, the socket is non persistent and is 
only established momentarily to reset values which will stop the 


navigation costate. 


The use of both persistent and non-persistent sockets was based on programmer’s 
preference and a desire for direct control of communication links that were being opened. 
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JAVA C Control 
Application Program 

Motor Manual 
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Figure 15. Program Interaction and SOCKETS 


B. CONTROL PROGRAM 


The control program (Alltask.c) for the SMART robot is written in Dynamic C 
and controls all tasks of the robot in a cooperative multitasking environment (figure 18). 
The program has five costates that perform the basic functions of the robot: manual motor 
control, GPS and compass update, navigation, stop navigation and web page server. 
These costates interact with the JAVA control application and with other functions within 


the Alltask.c program to govern operation of the robot. 
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Load Web 
Page Files 


Motor GPS Stop 
Control Compass Navigation 
Update 


Motor Navread 
Function Function 


Figure 16. BL2000 Control Program 
1. Motor Control 
The motor control function of the Alltask.c program is used during manual 
control operations of the robot. A socket is established with the JAVA control 
application and a packet is received with a data stream that the motor control costate 


interprets. The JAVA application sends a comma delimited data stream, the first token is 


a placeholder, the second is the motor designator, and the third is the speed and direction 


P| 





control variable. Using a string tokenizer function, the program converts the value of the 
speed and direction variable to motor speed variable, the program then calls the motor 
control function which places the appropriate output value on the BL2000 analog outputs 
which is then converted to a pulse width by the PWM circuit for feeding to the motor 
controllers. 


2: GPS/Compass Update 


The GPS/Compass co-statement queries the GPS and compass cards and then 
forwards the received data to the JAVA application for display. The GPS and compass 
cards provide a standard ASCII output hat is routed to the "serial a" and "serial b" ports 
on the BL2000. The costate waits until a socket is established before performing any 
reading functions, which allows the function to be “sleeping” until called upon by the 
user via the JAVA application. The function firsts flushes the buffers for the serial ports 
and waits for the latest input from both the GPS and compass. The input strings are then 
copied to a buffer variable and using the puts command sends that string to the JAVA 


application and closes it’s sockets and begins to wait for another input. 


The GPS data string is long and, as with the motor control string, needs to be 


tokenized to parse out needed data from the string. 
The string is formatted as follows: 


@ @Eq,mm,dd,yy,ss,dd,mm.mmmm,n,dd,mm.mmmm,w,shhhhh.h,sss.s,hhh.h, 
m,t, dd.d,nn,rrrr,aa, CCC<CR><LF>. 


¢ @@Eq >> Header 

e mm,dd,yy,ss >> Time stamp 
e = ddmm.mmmm >> Latitude 

e n>> North or South 

e = dd,mm.mmmm >> Longitude 
e w>> East or West 


e = shhhhh.h >> Height 
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e sss.s >> Velocity 

e hhh.h >> Heading 

e m,t,dd.d,mrr,aa >> Receiver, Signal and Satellite Status 
e CCC >> Checksum 


This data string is comma delineated and can therefore be separated into its separate 
components using the string tokenizer function in Dynamic C. The needed data from the 
GPS card is just he heading portion of the data string that is highlighted in bold above. 
Additional data from the GPS card includes in order, a leading time stamp, height, 
velocity, heading, receiver status and a final checksum. The data string is 96 bytes long 
and this length is used in the software as a method to determine if a valid string has been 
received. 


3. Navigation 


The navigation costate like the GPS/Compass costate waits for an input from the 
user before coming out of the sleep state. Upon receipt of a Desired Heading or Location 
string (DHeadLoc) from the JAVA application the navigation costate tokenizes the 
DHeadLoc string and determines its size and the value of its components. The navigation 
costate then calls the navread function which depending on the size of the DHeadLoc 
string will either conduct a GPS location calculation or a heading calculation determining 
a Course To Steer (CTS) and a difference between the CTS and the current heading. The 
difference value is then returned to the navigation costate which depending upon the 
values of the difference will turn towards the desired heading. When the desired location 
is reached, the robot will automatically stop and signal that it has completed the 
navigation costate. 


a. Feedback Error Control 

The principle of control for a robotic system is straightforward in that we 
will employ mechanisms to minimize some error function, figure 17. If we assume that 
our goal is to turn the robot to a desired angle 8, from a current angle 0, then the error E 
would be given by: 


(4) E=6,-0 
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Now if we apply a drive signal to the plant that is proportional to E, then we can say that 
our feedback mechanism invokes proportional error control in our system. The equation 


of motion for such motion is given by: 


(Di =J,0+F0 where 0 ae: and @ = a’ 
dt 





T,, is the motor torque, J,,=J,+J,,, Ji is the inertia of the load reflected through the 


m 


gears and J, is the inertia of the motors, F., is friction and © is angle. We can also say 


eq 


that: 
(6) T, = Kf 

where J is the motor current and K,,, is a constant. Equating (4) and (5) gives: 
(7) K,1=J6+F0 


If we invoke proportional control, we can assume that we will apply a current that is 
proportional to the error: 7«<E or we can say using equation (3) that /=k@,-8®), 


where k is aconstant. Therefore: 
(8) k,@, -8) = J0 + FO 


Here we have absorbed the constants k,,k into k, and rewritten J for J,, and F for F,, 


to simplify. Now if we assume that 8, =0_, then our equation of motion is: 
(9) JO+ FO+k9 =0 

If we assume a solution 8 =e“ and let k, =k then (8) reduces to: 
(10) Jq? +Fq+k =0 


Solving for q gives: 


We see that if: 
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e VF°—4Jk >0 (the system is over-damped) 
e VF*-—4Jk =0 (the system is critically damped) 


e VF°—4Jk <0 (the system is under-damped) 
Our goal was to provide critically damped control to the turn of the robot. 


The navread function in the navigation costatement determines the error 
signal applied in the proportional control algorithm. The error is multiplied by a constant 
K and converted to a signal to the plant, which causes motors to spin and the platform to 
turn. Assuming that J and F are constant we manipulate k to get our system response 
critically damped. We found that this was more difficult than imagined because, as it 


turns out, k is a function of time k(t) for our application. 


Error Controller Plant 
(Navigate (Navigate (Motors) 
Costate) Costate) 


Feedback 
(Digital 
Compass) 





Figure 17. Proportional Controller 


A combination of proportional, derivative and integrative (PID) would be 
the ideal method of feedback to use for a navigational system such as this. Hardware 
issues and the limitations of the platform made PID control difficult. Due to the power 
limitations of the Lemming chassis, a full power turn is required to ensure that the robot 
will tur on any terrain, a feedback system, which would slow the turn as the robot 


approached the desired heading, was therefore impractical. The time required to 
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complete a sample of the actual heading was also a factor since the compass was only 
providing output data at a rate of one string per second and testing showed that there was 
an indeterminate yet not insignificant compass delay while the output signal caught up 
with the actual heading. 

b. Where am I? 


In the navread function the robots desired and actual locations are 
compared and a desired heading is determined. The GPS inputs are converted to a grid 
location by a simple multiplication of the degrees and minutes by a constant to determine 
the distance north of the equator and by a constant and a scaling factor to determine the 
distance west of the prime meridian. Once the desired and actual locations are known 
trigonometry and Pythagoreans theorem are employed to determine the desired heading 
to steer and the distance to the desired location. The data is then fed back to the 
navigation costate which occasionally re-queries the navread function for an update on 
new headings and distance. 


Longitude 
Difference 


Prime 
meridian 







Desired 
Location 


Latitude 
Difference 


Location 


Figure 18. Distance and Course to Steer Calculations 
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The actual calculations to determine the location of the robot and the 
robot’s desired location are based on converting a GPS location to an equivalent grid 


point. The latitude in meters is determined by: 
(11) LATm = (LATDEG*60) + LATMIN)* 1852. 
The Longitude in meters is: 
(12) LONGm = -((LONGDEG*60) + LONGMIN)*1852*cos (.628 ). 


The cosine is used to correct for the difference in the sizes of a degree of latitude and 
longitude at the location of NPS. To make the program fully functional worldwide, the 
cosine correction must utilize the actual location of the robot and the software must be 


further modified to recognize east longitudes and south latitudes. 


C. CONTROL INTERFACE 


A goal of the SMART project was to construct a web based GUI that would both 
easily interact with the robot control program, form a user friendly interface, and be 
relatively easy to construct using available technologies and accessible instructor 
expertise as needed. Various programming methods were investigated including CGI 
scripts, PERL scripts and JAVA, based on the advice of NPS staff members from the 
computer science department it was decided to use JAVA. 

1. JAVA Application 


The JAVA application created is a multi-layered window utilizing sliders, 
pushbuttons and interactive text-boxes as a method of controlling and interacting with he 
SMART platform. JAVA automatically handles the multitasking issue, the user sets up 
“action event listeners” which will allow a thread to sleep until the button is pushed or the 
slider is moved. Similar to the process of programming in Dynamic C the frst actions in 
the initialization of a JAVA program is to call needed library functions and then to 
initialize variables. Once this initial setup is complete, the JAVA program can set up the 


control interface. 


The control interface is a multilayered window that has 2 sub-panels; the first 


panel is the manual control panel (figure 20), which has motor control sliders for control 
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of the left, right, and both motors. Manual push buttons allow for quicker access to full 
power left and right turns as well as full forward, full reverse and all motors stop. The 
navigation control panel (figure 21) contains non-editable text boxes for display of actual 
location and heading data, editable text boxes for input of commands, push buttons for 
entry of commands to either update the location/heading boxes or to commence or stop 
the navigation subroutine. Additional pushbuttons not used at this time are available for 
use in ordering the robot to conduct pre-programmed patterns that can be utilized for 


conducting mine search or surveillance patterns. 


& Robot Control 


| Manual Control | Robot Location | Status 


Left Motor R Forward 





Right Motor R | Left Turn Stop Right Turn 


Both Motors 
R 





Figure 19. Manual Control Panel 


& Robot Control | |O} x! 
(Manual Control | Robot Location | Status | 


Latitude: Longitude: Course: 
(i.e. 03,06.1234,N) (i.e. 067,09.9876,W) (Integer 0 to 360) 
ACTUAL | | 
ORDERED | | 


| Pattern 1 | Pattern 2 


Robot Status 

















Figure 20. Navigation Control Panel 


D. WEB INTERFACE 
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The BL2000 microprocessor is capable of serving a web page and this ability has 
the potential to greatly increase the operational ability of the SMART platform. One 
major feature of JAVA programs is the ability for the JAVA application to be converted 
to a JAVA applet that can be downloaded by a web server. A downloadable JAVA 
control applet would enable a remote user from any location in the world (with the proper 
access codes) the ability to control the SMART platform whether the operator had the 
control application loaded on a computer or not. When the additional capability of 
streaming video and increased communications abilities are added to the SMART 
platform, an operator could theoretically control the SMART platform from any location 
in the world. This increased capability would allow for real time command, control and 
access to sensor data as it was gathered at the highest levels of the chain of command 
making the SMART platform a valuable piece of the network-centric war. 

1. HTML Pages 


The present web of the SMART platform is rudimentary and is meant for a proof 
of concept only. A home page which will eventually be password protected provide 
credit to NPS and the CSS&T curriculum and acts as an access point to the following 
pages. Subsequent pages credit people who have worked on the SMART initiative and 
another provides links to hardware used during the projects. The last page downloads the 
JAVA control applet and will be further password protected. 
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IV. CONCLUSIONS/SMART FUTURE 


Autonomous and remotely controlled robotic systems will certainly have an 
increased role in future conflicts. The SMART vision was to create an ongoing research 
effort within the CSS&T Curriculum that engages in a forward-looking application of 
small robotic technology for military employment that goal has been reached with the 
completion of this second thesis of the SMART initiative. The specific goals 
accomplished during this thesis research included: 


e The successful operational demonstration of a lemming tracked vehicle in 
manual and autonomous modes. 

e The unique integration of diverse COTS components into a single operational 
platform. 

e The successful programming and integration of a GPS and digital compass 
navigation system. 

e The smooth interface between the microprocessor and the platform motors 
using a self designed PWM motor control circuit and COTS electronic speed 
control units. 

e The establishment of wireless networking for communications using TCP/IP 
socket connections. 

e The creation of a user friendly GUI using a JAVA application and the 
subsequent conversion of this GUI to a downloadable JAVA applet. 


With the completion of this initial research, the SMART platform waits for the 
completion of further sensor applications so that integration with these new platforms can 


be made. 


The future of the SMART initiative has many options; ongoing research within 
the CSS&T curriculum will certainly generate many new and exciting sensor platform 
options. The current Seismo-acoustic sonar sensor will be fully integrated with the 
SMART platform within a year and other projects include IR and chemical agent ensors. 
The capabilities of the SMART platform will also continue to increase, initial research 
has already been conducted into a video system and future plans include the design and 
production of a complete platform within the CSS&T curriculum accounting for all 
expected future requirements. The next generation SMART platform will employ 


advanced battery and power usage techniques as well as a modified track layout to enable 


a1 


icreased maneuverability. The addition of a second platform will enable more alvanced 


research in the areas of network centric warfare and cooperative engagements. 


The SMART initiative in the CSS&T curriculum at NPS has the potential to 
contribute greatly to the robotic capability of our expeditionary and covert forces. The 
addition of the SMART initiative strongly compliments ongoing NPS research into 
unmanned airborne vehicles, unmanned underwater vehicles and space-based systems. 
As missions such as_ surveillance, mine sweeping and chemical detection become 
increasingly dangerous, continued research in the area of autonomous and remotely 


controlled sensing platforms will be a cornerstone in our preparation for future conflict. 
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APPENDIX A. CONTROL PROGRAM IN DYNAMIC C 


/* Alltask.c 
Andrew G. Chicoine 
Novemb er 2001 
This program is written for the Z-World BL2000. 


This program multitasks the functions of the SMART robot: 


1. Manual control. 

2. GPS location and Compass heading updates. 
3. Automatic GPS Navigation. 

4. Stop Navigation Routine. 


5. Serve Web page. 


ie 2A. ie ee oe 2h 2 2A 2 2 2 ie ee a 2 2 2 2 2A. 2 ie ee ee ai 2 22 ie 2A 2 ie ee 2k 2K i 22 2K ie ee ae ak ae 2k 2 2 2k / 


//V ARIABLE DEFINITIONS FOR I/O AND INTERNET CONNECTIONS 


#define SERIAL_PORT_SPEED 115200 


//Some network stuff 


#define MY_IP_ADDRESS "131.120.101.81" 
#define MY_NETMASK "255.255.240.0" 
#define MY_GATEWAY "131.120.96.1" 
#define MY_NAMESERVER "131.120.254.58" 
#define MAX_SOCKETS 6 





/IMAPPING AND LIBRARY FILES TO USE 


#memmap xmem 
#use "dcrtcp.lib" 
#use "vserial.lib" 


#use "http.lib" 
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/IMPORT WEB PAGE 


#ximport "thesis/html/Robot!.html" Robot1!_html 


#ximport "thesis/html/Robot2.html" Robot2_html 


#ximport "thesis/html/Robot3.html" Robot3_html 


#ximport "thesis/html/Robot4.html" Robot4_html 


#ximport "thesis/html/Flag.gif" Flag_gif 
#ximport "thesis/html/nps.gif" nps_gif 
#ximport "thesis/html/robot.gif" robot_gif 


const HttpType http_types[] = 


{ 
{ "html", "text/html", NULL}, 


{ "gif", "image/gif", NULL}, 
// { "jpg", "image/jpeg", NULL} 
}s 


const HttpSpec http_flashspec[] = 


{ 
{ HTTPSPEC_FILE, "/", Robot!_html, 


NULL, 0, NULL, NULL}, 


{ HTTPSPEC_FILE, "/Robot!.html", Robotl_html, NULL,0, NULL, NULL}, 
{ HTTPSPEC_FILE, "/Robot2.html", Robot2_html, NULL,0, NULL, NULL}, 
{ HTTPSPEC_FILE, "/Robot3.html", Robot3_html, NULL,0, NULL, NULL}, 
{ HTTPSPEC_FILE, "/Robot4.html", Robot4_html, NULL, 0, NULL, NULL}, 
{ HTTPSPEC_FILE, "/Flag.gif", Flag_gif, NULL, 0, NULL, NULL}, 

{ HTTPSPEC_FILE, "/nps.gif", nps_gif, NULL, 0, NULL, NULL}, 

{ HTTPSPEC_FILE, "/robot.gif", robot_gif, NULL, 0, NULL, NULL}, 


} 


/[DEFINITIONS FOR ROBOT CONTROL 


#define PORTO 2000 
#define PORT1 2001 
#define PORT2 2002 
#define PORT3 2003 
#define PORT4 2004 
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#define PORTS 2005 


tcp_Socket Motorsock; 
tcp_Socket Headsock; 
tcp_Socket GPSsock; 
tcp_Socket DHeadLocsock; 
tcp_Socket StopNavsock; 


tcp_Socket Statussock; 


#define BINBUFSIZE 63 

#define BOUTBUFSIZE 63 

#define CINBUFSIZE 1023 

#define COUTBUFSIZE 1023 

#define TIMEOUT 40UL // will time out 20 milliseconds after receiving any 





// character unless MAXSIZE characters are received 
#define MAXSIZE 128 
#define MAXSIZE2 160 


char HeadIn[MAXSIZE]}; 
char GPSIn[MAXSIZE]; 
char HeadOut{[MAXSIZE2]; 
char GPSOut[MA XSIZE2]; 
int x; 

char HeadBuffer[2048]; 
char GPSBuffer[2048]; 

char DHeadLocBuffer[127]; 
char StopNavBuffer[3 1]; 
char DHeadLoc[127]; 

char StopNav[127]; 


//V ARIABLE DEFINITIONS FOR NAVIGATION 


float AVGCSE; /* Average heading to minimize hunting */ 
float CTS; /* Course to steer computed from waypoint and current location */ 
float ABSDIFF; /* Absolute difference between CTS and AVGCSE */ 
float DIST; /* Distance btween current location and WP */ 
float SPD; /* SPEED */ 
4] 


float DIFF; /* Difference between CTS and AVGCSE */ 


long 1; /* counter for delay */ 

int j; /* counter for nav loop*/ 

int n; /* subscript for variables */ 

int WPHEAD; 

double WPLATDEG; /* Waypoint position degrees of Latitude */ 
double WPLATMIN; /* Waypoint position minutes of Latitude */ 


double WPLONGDEG; /* Waypoint position degrees of Longitude */ 
double WPLONGMIN; /* Waypoint position degrees of Longitude */ 


double HDGMAG; /* Compass heading*/ 

double HDGTRU; /* Combination of HDGMAG + VAR + DEV*/ 
const double DEV = 4; /* Deviation for current location*/ 

const double VAR = 0; /* Variation due to motors*/ 

double SOG; /* Speed over ground of robot*/ 

double Speed; /* Dummy variable for SOG*/ 

double COG; /* GPS course over ground of robot*/ 


longword ip; 
int status; 
int count; 


float TurnTime; /*Proportional control for major turns*/ 


/IMOTOR CONTROL VARIABLES 


char MotorBuffer[5 12]; 
char DMotor[31]; 


const int channel0 = 0; 


const int channell = 1; 


float Motor_Speed; 
float LMotor_Speed; 
float RMotor_Speed; 


int Motor_Desig; 
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main() 


/ISTRING PARSE VARIABLES 


char *DHeadLoc0,*DHeadLoc1,*DHeadLoc2,*DHeadLoc3,*DHeadLoc4,*DHeadLoc5, 
*DHeadLoc6,*DHeadLoc7; 
char *DMotor0,*DMotor1,*DMotor2,*DMotor3,*DMotor4; 
char p[2]; 
plo] ="; 
pl1] =0; 
/*Tokenizer*/ 
//Open both serial ports 
serBopen(9600); 
serCopen(9600); 


//Flush serial port B & C input buffer 
serBrdFlushQ); 
serCrdFlush(); 


sock_initQ); 
brdInitQ); 
http_init(); 


tcp_reserveport(80); 


//Motor Socket 


tcp_listen(& Motorsock,PORTO,0,0,NULL,0); 
sock_wait_established(&Motorsock,0, NULL, &status); 
sock_mode(&Motorsock, TCP_MODE_ASCII); 


while(1) 
{ 


costate { 


// This costate manages motor control in the manual mode. 
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// Recieve data and feedback. 
// printf("1"); 
sock_tick(&Motorsock, &status); 
if (sock_bytesready(&Motorsock)>=0) { 
x = sock_gets(&Motorsock,MotorBuffer,5 12); 
// printf("%d\n", x); 
if(x>3){ 
sock_tick(&Motorsock, &status); 
sprintf(DMotor, "\"%s\"\n" ,MotorBuffer); 
sprintf(MotorBuffer, "\"%s\"\n\n",NULL); 
// printf("%s\n", DMotor); 
sock_tick(&Motorsock, &status); 
// waitfor(DelayMs(50)); 
sock_puts(&Motorsock,MotorBuffer); 
// waitfor(DelayMs(50)); 


sock_tick(&Motorsock, &status); 


// Control motors 


DMotor0 = strtok(DMotor, p); 
DMotor1! = strtok(NULL, p); 
Motor_Desig = atoi(DMotor1); 
// printf("Motor_Desig = %d\nn", Motor_Desig); 
sock_tick(&Motorsock, &status); 
DMotor2 = strtok(NULL, p); 
Motor_Speed = atof(DMotor2); 
// printf("Speed... Volts out = %f\n\n", Motor_Speed); 
sock_tick(&Motorsock, &status); 
DMotor3 = strtok(NULL, p); 


if (Motor_Desig == 0) /*LEFT*/ 
LMotor_Speed = Motor_Speed/100; 


if (Motor_Desig == 1) /*RIGHT*/ 
RMotor_Speed = Motor_Speed/100; 


if (Motor_Desig == 2){ /*BOTH*/ 
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LMotor_Speed = Motor_Speed/100; 
RMotor_Speed = Motor_Speed/100;} 


if (Motor_Desig == 3){ /*STOP*/ 
LMotor_Speed = 1.5; 
RMotor_Speed = 1.5;} 


Motor(); 


} 
}//End Costate 


costate { 


// This costate updates the GPS location and Heading in the Java application. 
// printf("2"); 


//Flush serial port B & C input buffer 


serBrdFlushQ); 
serCrdFlush(); 


//Head Socket 


tcp_listen(&Headsock,PORT1,0,0,NULL,0); 
waitfor(sock_established(&Headsock)); 
sock_mode(&Headsock,TCP_MODE_ASCID; 


//B Wait for the Heading message 
while ((n = serBread(HeadIn, MAXSIZE-1, TIMEOUT)) == 0) ; 
HeadIn[n] = 0; 


//Copy Heading to buffer and send 
sprintf(HeadOut, "%s",HeadIn); 
sprintf(HeadBuffer, "\" %s\"\n\n" ,HeadOut); 
sock_puts(&Headsock,HeadBuffer); 
sock_close(&Headsock); 
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// printf("\nHead done\n"); 


//GPS Socket 


tcp_listen(&GPSsock,PORT2,0,0,NULL,0); 
sock_wait_established(&GPSsock,0,NULL,&status); 
sock_mode(&GPSsock,TCP_MODE_ASCID); 


//C Wait for the GPS message 
while ((n = serCread(GPSIn, MAXSIZE-1, TIMEOUT)) == 0) ; 
GPSIn[n] = 0; 


//Copy messages to out variables and send 
sprintf(GPSOut, "%s",GPSIn); 
sprintf(GPSBuffer, "\"%s\"\n\n" ,GPSOut); 
sock_puts(&GPSsock,GPSBuffer); 
sock_close(&GPSsock); 
// printf("\nGPS done\n"); 


} //End costate 


costate { 


// This costate manages navigation. 
// printf("3"); 
//DHeadLoc Socket 


tcp_listen(&DHeadLocsock,PORT3,0,0,NULL,0); 
waitfor(sock_established(&DHeadLocsock)); 
sock_mode(&DHeadLocsock,TCP_MODE_ASCID; 
sock_wait_input(&DHeadLocsock,0,NULL, &status); 
x = sock_gets(&DHeadLocsock, DHeadLocBuffer,5 12); 
sprintf(DHeadLoc, "\"%s\"\n\n",DHeadLocBuffer); 

// printf("%s\n", DHeadLoc); 
sock_close(&DHeadLocsock); 


// printf("\nDHeadLoc done\n"); 
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sock_err: 
switch(status) { 
case 1: /* foreign host closed */ 
// printf(""User closed session\n"); 


break; 


case -1: /* timeout */ 
// printf("\nConnection timed out\n"); 


break; } 


//Check if desired GPS location or heading has been entered 


if(strlen(DHeadLoc)>8) { 


[78 8 ss 3g 2 2 2A 2 2 2 ie hee ae ae ae 2 2 2A 2 ee ie hee a 2 22S 2 22K ie ie fe ae ae ae 2k 2K 2c 2. ee 2c ie ee 3k 2K 2K 222A. 2 ie ee ak ae 2 2k 2K 2K 2 2k 


/*Move towards a given GPS Location or Heading.*/ 


[78 8 ss 3g 2 2 2A 2 2 2K ie hee ae ae 3 2 2 2A. 2 ee ie he fe a 2h 2 2A. 222A eke fe ae ae ae 2k 2 2A 2A. ee 2c ie fe ae 3k 222 2 2A 2 ie fe ae ae a 2 2 2 2K 2 2k 2k 


//printf("\nCommencing Navigation loop\n"); 


//Convert DHeadLoc String to Way Point Variables 


//printf("%s\n" ,DHeadLoc); 
x = strlen(DHeadLoc); 
//printf("Stringlength = %f\n", x); 
DHeadLoc0 = strtok(DHeadLoc, p); 
DHeadLoc1 = strtok(NULL, p); 
WPHEAD = atoi(DHeadLoc1); 
printf("WPHEAD = %d\n", WPHEAD); 
DHeadLoc2 = strtok(NULL, p); 
WPLATDEG = atof(DHeadLoc2); 
printf("WPLat Degrees = %f\n", WPLATDEG); 
DHeadLoc3 = strtok(NULL, p); 
WPLATMIN = atof(DHeadLoc3); 
printf("WPLat Minutes = %f\n", WPLATMIN); 
DHeadLoc4 = strtok(NULL, p); 
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DHeadLoc5 = strtok(NULL, p); 

WPLONGDEG = atof(DHeadLoc5); 
printf("WPLong Degrees = %f\n", WPLONGDEG); 
DHeadLoc6 = strtok(NULL, p); 

WPLONGMIN = atof(DHeadLoc6); 
printf("WPLong Minutes = %f\n", WPLONGMIN); 
DHeadLoc7 = strtok(NULL, p); 


DIST = 25; 


//Main Navigation Loop 


while(DIST>20){ 


// printf("3"); 


/*Tnitial read.*/ 
navread(); 
yield; 


/*Check for major course correction and turn.*/ 


while (ABSDIFF >= 15 && (360-ABSDIFF) >= 15 && DIST >20){ 
navread(); 
if (ABSDIFF <= 180) { 
if (DIFF <= 0){printf("1"); /*Right turn*/ 
LMotor_Speed = 2; 
RMotor_Speed = 1;} 
else {/*Left turn*/ 


LMotor_Speed = 1; 





RMotor_Speed = 2;} 
} 
else{ 
if (DIFF > 0) { /*Right turn*/ 
DIFF= 360-ABSDIFF; 
LMotor_Speed = 2; 
RMotor_Speed = 1;} 
else {/*Left turn*/ 
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DIFF = 360-ABSDIFF; 
LMotor_Speed = 1; 
RMotor_Speed = 2;} 
} 


MotorQ); 


/*Determine time for turn depending on error PROPORTIONAL CONTROL*/ 


if (ABSDIFF <= 180) 
TurnTime = ABSDIFF/180; 
else 
TumTime = (360 - ABSDIFF)/180; 
TurnTime = TurnTime*250000; 
for (i = 1; i1<= TurnTime; i++); 
/*Motors Stop*/ 
LMotor_Speed = 1.5; 
RMotor_Speed = 1.5; 


Motor(); 
yield; 
} 


/*Midcourse correction.*/ 


if (ABSDIFF >= 5 && (360-ABSDIFF) >=5){ 
if (ABSDIFF <= 180) { 
if DIFF <=0){  /*Right turn*/ 
LMotor_Speed = 2; 
RMotor_Speed = 1;} 


else {/*Left turn*/ 
LMotor_Speed = 1; 
RMotor_Speed = 2;} 
} 
else{ 
if (DIFF > 0) {/*Right turn*/ 
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DIFF= 360-ABSDIFF; 
LMotor_Speed = 2; 
RMotor_Speed = 1;} 
else {/*Left turn*/ 
DIFF = 360-ABSDIFF; 
LMotor_Speed = 1; 
RMotor_Speed = 2;} 
} 
Motor(); 


} 
for (i = 1; i<= 25000; i++); 


/*Forward movement.*/ 


if (DIST > 20){/*Move forward*/ 
LMotor_Speed = 2; 
RMotor_Speed = 2; 
MotorQ); 
for (i = 1; 1 <= 150000; i++); } 

else{/*Motors Stop*/ 
LMotor_Speed = 1.5; 
RMotor_Speed = 1.5; 
Motor();} 


yield; 


/TEXTT FROM LOOP DANCE 


/*Motors Stop*/ 
LMotor_Speed = 1.5; 
RMotor_Speed = 1.5; 
Motor(Q); 

for (i = 1; i<= 50000; i++); 
/*Right Turn*/ 
LMotor_Speed = 2; 
RMotor_Speed = 1; 
Motor(); 
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for (i= 1; i<= 50000; i++); 
/*Left Turn*/ 
LMotor_Speed = 1; 
RMotor_Speed = 2; 
Motor(); 

for (i = 1; i<= 50000; i++); 
/*Motors Stop*/ 
LMotor_Speed = 1.5; 
RMotor_Speed = 1.5; 


MotorQ); 
for (i= 1; i<= 50000; i+4); 
} 


else; { 


[78 8 ss 3g 2 2 2A 2 2 2 ie hee ae ae ae 2 2 2A. 2 ee ie hee a 2h 22S 22 2 ie ke fe ae ae ae ak 2 2c 2A. ee 2c ie ee 3k 22 22 2K. 2 ie ee ak ae ai 2 2K 2K 2k 2k 
/*Only update GPS & Compass data.*/ 


78 8 ss 3g 2 2 2A 2 2 2. ie hee ae ae ae 2 2 2A 2 ee ie he fe a 2h 2 2A 22 2A ic he fe ne ae ae 2k 2K 2A 2K. ee 2c ie fe ae 3h 22 22 2A 2 ie fee ae a oi 2 2 2K 2 2k / 


} 
// printf("\nLoop done\n"); 


}//End Navigation Costate 


costate{ /*This costate stops the navigation loop*/ 


//StopNav Socket 
//printf("4"); 


tcp_listen(&StopNavsock,PORT4,0,0,NULL,0); 
waitfor(sock_established(&StopNavsock)); 
sock_mode(&StopNavsock,TCP_MODE_ASCID; 
sock_close(&StopNavsock); 
DIST = 0; 

}//End Costate 


costate { /*This costate operates the web page */ 
// printf("S"); 
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http_handler(); 
}//End Costate 


}//End While 
\//End Main 


[78 8 es 3g 2 2 2A 2 2 2 ie hee ae ae ae 2 2 2A 2 ee eee a 2 2 2A. 222A ie ie fe ae 2 a 2 2 2A 2A. ee fe ie fe ae 2k 22K 2K 2 2A 2c ie ee ae ae ai 2 2K 2K 2k 2k 


/*Function to read in Navigation data and convert.*/ 


78 8 ss 3g 2 2 2A 2 2 2A ie hee ae ae ae 2 2 2A. 2 ee ie he fe a 2h 2K 2A 222 ie he fe ae ae ae 2h 2 2A 2A. ee 2c ie ee 3h 2K 2A 222A. 2 ie fee 3 a ai 22 2K 2 2K ok 


navread() { 


double LATDEG; 
double LATMIN; 
double LONGDEG; 
double LONGMIN; 
double LATm; 
double LONGm; 
double WPLATm; 
double WPLONGm; 
double NUMSAT; 
double ALT; 
double DOP; 


double DIFFLATm; 
(meters)*/ 


double DIFFLONGm; 
(meters)*/ 


const double pi = 3.14; 


/ISTRING PARSE VARIABLES 


je 
* 
je 
js 
js 
je 
js 
js 
js 
js 
js 
js 


/* 


/* 


Current position degrees of Latitude */ 

Current position minutes of Latitude */ 

Current position degrees of Longitude */ 

Current position minutes of Longitude */ 
Converted Latitude into meters from equator er 
Converted Longitude into meters from meridian */ 
Converted Latitude into meters from equator*/ 
Converted Longitude into meters from meridian*/ 
Number of satalites*/ 

Altitude in meters*/ 

Quality of GPS signal*/ 


Difference in latitude between the current position and WP 


Difference in longitude between the current position and WP 


Pi */ 


char *GPSInO,*GPSIn1,*GPSIn2,*GPSIn3,*GPSIn4,*GPSIn5,*GPSIn6; 
char *GPSIn7,*GPSIn8,*GPSIn9,*GPSIn10,*GPSIn11,*GPSIn12,*GPSIn 13; 


char *GPSIn14,*GPSIn15,*GPSIn16,*GPSIn17,*GPSIn18,*GPSIn19,*GPSIn20; 


char *GPSIn21,*GPSIn22; 


char GPS7[10],GPS8[10],GPS 10[10],GPS 1 1[10]; 
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char q[2]; 
ql] ="; 
q{ 1] =0; 


/*Tokenizer*/ 


if(x>30){ 


//Flush serial port B & C input buffer 


serBrdFlushQ); 
serCrdFlush(); 


tcp_tick(&StopNavsock); 


//Wait for the GPS message from the GPS card, tokenize and convert to integers 


while ((n = serCread(GPSIn, MAXSIZE- 1, TIMEOUT)) == 0) ; 
GPSIn[n] = 0; 


if(strlen(GPSIn)>92){ 
// printf("%s\n",GPSIn); 


GPSIn0 = strtok(GPSIn, q); 
GPSIn1 = strtok(NULL, q); 
GPSIn2 = strtok(NULL, q); 
GPSIn3 = strtok(NULL, q); 
GPSIn4 = strtok(NULL, q); 
GPSIn5 = strtok(NULL, q); 
GPSIn6 = strtok(NULL, q); 








GPSIn7 = strtok(NULL, q); 

// printf("GPSIn7 = %s\n",GPSIn7); 
LATDEG = atof(GPSIn7); 

// printf(""Lat Degrees = %f\n", LATDEG); 
GPSIn8 = strtok(NULL, q); 

// printf("GPSIn8 = %s\n",GPSIn8); 
LATMIN = atof(GPSIn8); 

// printf("Lat Minutes = %f\n", LATMIN); 
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GPSIn9 = strtok(NULL, q); 

GPSIn10 = strtok(NULL, q); 

// printf('GPSIn10 = %s\n",GPSIn10); 
LONGDEG = atof(GPSIn10); 

// printf(""Long Degrees = %f\n", LONGDEG); 
GPSIn11 = strtok(NULL, q); 

// printf("GPSIn11 = %s\n",GPSIn11); 
LONGMIN = atof(GPSIn11); 

// printf("Long Minutes = %f\n", LONGMIN); 
GPSIn12 = strtok(NULL, q); 

GPSIn13 = strtok(NULL, q); 

GPSIn14 = strtok(NULL, q); 

GPSIn15 = strtok(NULL, q); 

GPSIn16 = strtok(NULL, q); 

GPSIn17 = strtok(NULL, q); 

GPSIn18 = strtok(NULL, q); 

GPSIn19 = strtok(NULL, q); 

GPSIn20 = strtok(NULL, q); 

GPSIn21 = strtok(NULL, q); 

GPSIn22 = strtok(NULL, q); 








//scanf("%f" ,& SOG); 
//scanf("%f" ,& COG); 


//Flush serial port B & C input buffer 


serBrdFlushQ); 
serCrdFlush(); 


tcp_tick(&StopNavsock); 


//Wait for the Heading message from compass card and convert to an integer 
while ((n = serBread(HeadIn, MAXSIZE-1, TIMEOUT)) == 0) ; 


HeadIn[n] = 0; 
HDGMAG = atoi(HeadIn); 
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tcp_tick(&StopNavsock); 
/*Convert degree based LAT/LONG to meters.*/ 


LATm = (LATDEG* 60)+LATMIN)* 1852; 

LONGm = -(LONGDEG*60)+LONGMIN)*1852*cos (.628 ); 
// printf("longm = %f\n",LONGm); 

// printf("latm = %f\n" ,LATm); 


/*Convert Waypoint LAT/LONG to meters.*/ 


WPLATm = ((WPLATDEG*60)+WPLATMIN)* 1852; 

WPLONGm = -((WPLONGDEG*60)+WPLONGMIN)* 1852*cos (.628); 
// printf("wplongm = %f\n",WPLONGm); 

// printf("wplatm = %f\n",;WPLATm); 


/*Determine hdg and dist to WP.*/ 


DIFFLONGm = WPLONGm - LONGm; 
DIFFLATm = WPLATm - LATm; 

// printf("difflongm = %f\n",DIFFLONGm); 
// printf("difflatm = %f\n",DIFFLATm); 


DIST = sqrt DIFFLONGm*DIFFLONGm + DIFFLATm*DIFFLATm); 
// printf("dist = %f\n" ,.DIST); 


/IDIVIDE BY ZERO PREVENTION 
if(DIFFLONGm = 0) 
DIFFLONGm = 0.001; 
if(DIFFLATm == 0) 
DIFFLATm = 0.001; 


//Conditional statements to determine heading depending upon quadrant 


if(DIFFLONGm>=0 && DIFFLATm>=0) 
{CTS = 180/pi * atan (DIFFLONGm/DIFFLATm); } 
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else if(DIFFLONGm>=0 && DIFFLATm<=0) 
{CTS = 90 - 180/pi * atan (DIFFLATm/DIFFLONGm); } 


else if(DIFFLONGm<=0 && DIFFLATm>=0) 
{CTS = 360 + 180/pi * atan (DIFFLONGm/DIFFLATm); } 


else 


{CTS = 180 + 180/pi * atan (DIFFLATm/DIFFLONGm); } 


printf("cts = %f\n",CTS); 


/*Apply magnetic dev and var corrections and determine velocity and time average hdg.*/ 


HDGTRU = HDGMAG + DEV + VAR; 
if (SOG > 1) Speed = SOG; 


else Speed = 0; 
if (fabs(A VGCSE - HDGTRU) >= 20) AVGCSE = HDGTRU; 
AVGCSE = (AVGCSE + HDGTRU + Speed*COG)/(2+Speed); 
ABSDIFF = fabs(A VGCSE-CTS); 
DIFF =(AVGCSE-CTS); 


/ffor (i = 1; i <= 100000; i++); 


/*Test output. */ 


printf("hdgtru = %f\n", HDGTRU); 

// printf('AVGCSE = %f\n", AVGCSE); 
printf("absdiff = %f\n",ABSDIFF); 
printf("diff = %f\n" DIFF); 

} 


else{ 


[78 8 ss 3g 2 2 2A 2 2 2 ie hee ae ae ae 2 2 2A. 2 ee ie ee a 2h 22.222 ie kee ae ae ae 2k 2 2s 2S ee 2c ie kee 3k 22K 22 2K. 2c ie ee a ai ai 2 2 2K 2k 2k / 


/*Function to read in Heading data and convert.*/ 


[78 8 ss 3g 2 2 2A 2 2A 2 ie hee ae ae 3 2 2 2A. 2 ee ie hee a 2h 22.22 2A eke ee ae a 2k 2K 2 2A. ee 2c ie kee 3h 222i 2 2A 2 ie ee 2 ae ai 2K 2 2K 2k 2k / 
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//Flush serial port B & C input buffer 


serBrdFlushQ); 
serCrdFlush(); 


//Wait for the Heading message from compass card and convert to an integer 


while ((n = serBread(HeadIn, MAXSIZE-1, TIMEOUT)) == 0) ; 
HeadIn[n] = 0; 

HDGMAG = atoi(HeadIn); 

CTS = WPHEAD; 

printf("cts = %f\n",CTS); 


/*Apply magnetic dev and var corrections and determine velocity and time average hdg.*/ 


HDGTRU = HDGMAG + DEV + VAR; 

if (SOG > 1) Speed = SOG; 

else Speed = 0; 

if (fabs(A VGCSE - HDGTRU) >= 20) AVGCSE = HDGTRU; 
AVGCSE = (AVGCSE + HDGTRU + Speed*COG)/(2+Speed); 
ABSDIFF = fabs(AVGCSE-CTS): 

DIFF =(AVGCSE-CTS); 

} 
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[78 8 ss ae 2 2 2A 2 2 2 ie hee ae ae ae 2h 2 2A 2 ie 2A. ie ee ae 2h 2 3 222A ce fe ae ae ae 3k 22s 2A. ie 2A 2 ie ee ok 22 22 2A 2 ie ee ee ai 2k 2 2K 2 2k 


/*Function to Control Motors.*/ 


[78 8 ss 3g 2 2 2A 2 2 2 ie hee ae ae ae 2h 2 2A 2 ee ie ee a 2h 2 2A 222A eke fe ae ae ae 2k 22 2A ee 2c ie fe ae ah 22S 2i 2 2A 2 ie fee oe ae ai 2 2K 2K 2 2k 


Motor(){ 


{e Analog channel 0 = Left Motor 
Analog channel | = Right Motor */ 


anaOutVolts(channel0, LMotor_Speed); 
anaOut Volts(channell, RMotor_Speed); 
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APPENDIX B. CONTROL INTERFACE IN JAVA 


//RobotControl.java 
//Andrew G. Chicoine 
//November 2001 


//This program is the GUI for the SMART robot. 
//1, Slider and pushbutton control. 

/!2. Receive GPS & Compass updates. 

//3. Send GPS & heading commands. 


/Amport javax.media.*; 

/Amport com.sun.media.ui.*; 
/Amport javax.media.protocol.*; 
/Amport javax.media.protocol.DataSource; 
import javax.swing.*; 

import javax.swing.event.*; 
import java.awt.*; 

import java.awt.event.*; 

import java.net.*; 

import java.io.*; 

import java.util. Vector; 

import java.util.*; 


public class RobotControl extends JFrame { 


public _ static final int REVERSE = 100; 
public static final int FORWARD = 200; 
public _ static final int STOP = 150; 


private JPanel mainPanel = new JPanel(new BorderLayout()); 


protected JTabbedPane tabs = new JTabbedPane(); 

protected DefaultListModel model = new DefaultListModelQ; 
protected JList list = new JList(model); 

protected JSlider leftMotor; 

protected JSlider rightMotor; 

protected JSlider bothMotor; 

protected Socket sock; 

protected BufferedReader cmdIn; 

protected OutputStream cmdOut; 
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private JTextField lat, longi, head, Dcourse, DLat, DLong, RobotStatus; 

private int numcourse, numDcourse, numDLatDeg, numDLatMin, numDLongDeg, numDLongMin; 
private Button Update; 

private Button StopNav; 

private Button Go; 

String incourse = new StringQ); 

String inlat = new String(); 

String inlongi = new String(); 
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String inHead = new String(); 

String inGPS = new String(); 

String StrDHead = new String(); 

String StrDLat = new StringQ); 

String StrDLong = new String(); 

String StrDHeadLoc = new String(); 

String nohit = "No GPS Update Available..."; 
String HO = "Turning to desired heading"; 
String NAV = "Commencing Navigation Routine"; 
String NA = "No action performed"; 

String LT = "Turning Left..."; 

String RT = "Turning Right..."; 

String TC = "Turn Complete..."; 


/INETWORK VARIABLES FOR HEADING AND GPS 


private Socket Headsock; 
private Socket GPSsock; 
private Socket DHeadLocsock; 
private Socket StopNavsock; 


private BufferedReader HeadIn; 
private OutputStream HeadOut; 


private BufferedReader GPSIn; 
private OutputStream GPSOut; 


private BufferedReader DHeadLocIn; 
private OutputStream DHeadLocOut; 


private BufferedReader StopNavIn; 
private OutputStream StopNavOut; 


private static final String ip = "131.120.101.81"; 
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public RobotControl(String ip) { 
super("Robot Control"); 
setDefaultCloseOperation(JFrame.DO_NOTHING_ON_CLOSE); 
addWindowListener( 
new WindowAdapter() { 
public void windowClosing(WindowEvent ev) { 
terminate(); 


} 
}); 


setLocation(200,350); 
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/* This section sets up the network socket and port for the client/server 
relationship */ 


/INETWORKING for CLIENT/SERVER 
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try { 

sock = new Socket(ip, 2000); 

cmdIn = new BufferedReader(new InputStreamReader(sock.g etInputStream())); 
cmdOut = sock.getOutputStream(); 

} catch (Exception ex) { 

System.err.printIn("Could not connect to " + ip + "\nQuitting."); 
System.exit(0); 

} 
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// GENERAL LAYOUT (Panel Assignments) 


GridBagLayout gbl = new GridBagLayout(); 
GridBagConstraints gbc = new GridBagConstraints(); 


/[MANUAL CONTROL TAB 
JPanel main = new JPanel(new BorderLayout()); 
//Sliders 
JPanel controls = new JPanel(gbl); 
//Buttons 
JPanel butt = new JPanel(gbl); 


GridBagLayout gblay = new GridBagLayout(); 
GridBagConstraints gbcon = new GridBagConstraints(); 


//AUTO-MODE TAB 
JPanel autonomous = new JPanel(new BorderLayout()); 
//Lat, Long, & Heading 
JPanel q = new JPanel(gblay); 
//Robot Status 
JPanel p = new JPanel(gblay); 
//Navigation GPS 
JPanel s = new JPanel(gblay); 
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/* This is the motor controller section. Control sliders are created for 
the Left and Right Motor Speeds. Control Buttons are created for 
movement and direction. */ 


/[LEFT MOTOR SPEED ONLY 
leftMotor = new JSlider(JSlider. HORIZONTAL, REVERSE, FORWARD, STOP); 
leftMotor.addChangeListener( 
new ChangeListener() { 
public void stateChanged(ChangeEvent ev) { 
int val = leftMotor.getValueQ); 
try { 
/* First variable x is a place holder, second variable is the motor designator: 
L=0,R=1,B=2,S=3, val is the speed variable. */ 


cmdOut.write(("x,0," + val + "\n").getBytes()); 
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for (int i = 0; i<100000;i++) { } 
model.addElement(cmdIn.readLine()); 
} catch (Exception ex) { 
} 
} 
)); 
leftMotor.setMajorTickSpacing(50); 
leftMotor.setMinorTickSpacing(5); 
leftMotor.setSnapToTicks(true); 
leftMotor.setPaintTicks(true); 


//Create the label table 
Hashtable labelTable = new Hashtable(); 
labelTable.put( new Integer( REVERSE ), new JLabel("R") ); 
labelTable.put( new Integer( STOP), new JLabel("S") ); 
labelTable.put( new Integer( FORWARD ), new JLabel("F") ); 


leftMotor.setLabelTable( labelTable ); 
leftMotor.setPaintLabels(true); 
leftMotor.setB order(BorderFactory.createEmptyBorder(0,0,10,0)); 
gbc.gridx = 0; 
gbc.gridwidth = 2; 
gbc.gridy = 0; 
gbc.gridheight = 2; 
JLabel label = new JLabel("Left Motor"); 
gbl.setConstraints(label, gbc); 
controls.add(label); 
gbc.gridx = 2; 
gbc.gridy = 0; 
gbl.setConstraints(leftMotor, gbc); 
controls.add(leftMotor); 


/[RIGHT MOTOR SPEED ONLY 
rightMotor = new JSlider(JSlider. HORIZONTAL, REVERSE, FORWARD, STOP); 
rightMotor.addChangeL istener( 
new ChangeListener() { 
public void stateChanged(ChangeEvent ev) { 
int val = rightMotor.getValue(); 
try { 
cmdOut.write(("x,1," + val + "\n").getBytes()); 
for (int i = 0; i<100000;i++){ } 
model.addElement(cmdIn.readLine()); 
} catch (Exception ex) { 
} 
} 
ys 
rightMotor.setMajorTickS pacing(50); 
rightMotor.setMinorTickSpacing(5); 
rightMotor.setSnapToTicks(true); 
rightMotor.setPaintTicks(true); 


//Create the label table 
rightMotor.setLabelTable( labelTable ); 
rightMotor.setPaintLabels (true); 
rightMotor.setBorder(BorderFactory.createEmptyBorder(0,0,10,0)); 
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gbc.gridx = 0; 

gbc.gridwidth = 2; 

gbc.gridy = 2; 

gbc.gridheight = 2; 
label = new JLabel("Right Motor"); 

gbl.setConstraints(label, gbc); 
controls.add(label); 

gbc.gridx = 2; 

gbc.gridy = 2; 

gbl.setConstraints(rightMotor, gbc); 
controls.add(rightMotor); 


/[BOTH MOTOR SPEEDS 
bothMotor = new JSlider(JSlider. HORIZONTAL, REVERSE, FORWARD, STOP); 
bothMotor.addChangeListener( 
new ChangeListener() { 
public void stateChanged(ChangeEvent ev) { 

int val = bothMotor.getValue(); 

leftMotor.set Value(val); 

rightMotor.set Value(val); 

try { 

cmdOut.write(("x,2," + val + "\n").getBytes(); 
for (int i = 0; i<100000;i++4){ } 
model.addElement(cmdIn.readLine()); 
} catch (Exception ex) { 
} 
} 
)); 

bothMotor.setMajorTickSpacing(10); 
bothMotor.setMinorTickSpacing(5); 
bothMotor.setSnapToTicks (true); 
bothMotor.setPaintTicks(true); 


//Create the label table 
bothMotor.setLabelTable( labelTable ); 
bothMotor.setPaintLabels(true); 
bothMotor.setBorder(BorderFactory.createEmptyBorder(0,0,10,0)); 

gbc.gridx = 0; 

gbc.gridwidth = 2; 

gbc.gridy = 4; 

gbc.gridheight = 2; 
label = new JLabel("Both Motors"); 

gbl.setConstraints(label, gbc); 
controls.add(label); 

gbc.gridx = 2; 

gbc.gridy = 4; 

gbl.setConstraints(bothMotor, gbc); 
controls.add(bothMotor); 





main.add(controls, BorderLayout. WEST); 


/ISTOP BUTTON 
63 


JButton stop = new JButton("Stop"); 
stop.addActionListener( 
new ActionListener() { 
public void actionPerformed(ActionEvent ev) { 
try { 
cmdOut.write("x,3,\n" .getBytes(); 
model.addElement(cmdIn.readLine()); 
} catch (Exception ex) { 
} 
leftMotor.setValue(STOP); 
rightMotor.setValue(STOP); 
bothMotor.set Value(STOP); 


} 

ps 
gbc.gridx = 3; 
gbc.gridy = 3; 


gbc.gridwidth = 2; 

gbc.gridheight = 2; 

gbc.ipadx = 10; 

gbc.ipady = 10; 

gbc.insets = new Insets(10,0,0,0); 
gbl.setConstraints(stop, gbc); 
butt.add(stop); 


/I/FORWARD BUTTON 
JButton forward = new JButton("Forward"); 
forward.addActionListener( 
new ActionListener() { 
public void actionPerformed(ActionEvent ev) { 
try { 
cmdOut.write("x,2,200,\n".getBytes()); 
model.addElement(cmdIn readLine()); 
} catch (Exception ex) { 
} 
leftMotor.setValue(STOP+50); 
rightMotor.setValue(STOP+50); 
bothMotor.setValue(STOP+50); 


} 

))s 
gbc.gridx = 3; 
gbc.gridy = 1; 


gbc.gridwidth = 2; 

gbc.gridheight = 1; 

gbc.ipadx = 20; 

gbc.ipady = 20; 

gbc.insets = new Insets(5,5,5,5); 
gbl.setConstraints(forward, gbc); 
butt.add(forward); 


/[LEFT TURN BUTTON 
JButton leftturn = new JButton("Left Turn"); 
leftturn.addActionListener( 
new ActionListener() { 
public void actionPerformed(ActionEvent ev) { 
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try { 
// cmdOut.write("x,3,\n".getB ytes()); 
model.addElement(cmdIn.readLine()); 
} catch (Exception ex) { 
} 
leftMotor.set Value(STOP-50); 
rightMotor.setValue(STOP+50); 


} 

))s 
gbc.gridx = 1; 
gbc.gridy = 3; 


gbc.gridheight = 4; 

gbc.ipadx = 20; 

gbc.ipady = 20; 
gbl.setConstraints(leftturn, gbc); 
butt.add(leftturn); 


/[RIGHT TURN BUTTON 
JButton rightturn = new JButton(""Right Turn"); 
rightturn.addActionListener( 
new ActionListener() { 
public void actionPerformed(ActionEvent ev) { 
try { 
// cmdOut.write("x,3,\n".getBytes()); 
model.addElement(cmdIn.readLine()); 
} catch (Exception ex) { 
} 
leftMotor.setValue(STOP+50); 
rightMotor.setValue(STOP-50); 


} 

ys 
gbc.gridx = 5; 
gbc.gridy = 3; 


gbc.gridheight = 4; 

gbc.ipadx = 20; 

gbc.ipady = 20; 
gbl.setConstraints(rightturn, gbc); 
butt.add(rightturn); 


/[REVERSE BUTTON 
JButton backward = new JButton("Reverse"); 
backward.addActionListener( 
new ActionListener() { 
public void actionPerformed(ActionEvent ev) { 
try { 
// cmdOut.write("x,3,\n".getB ytes()); 
model.addElement(cmdIn.readLine()); 
} catch (Exception ex) { 
} 
leftMotor.setValue(RE VERSE); 
rightMotor.setValue(REVERSE); 
bothMotor.setValue(REVERSE); 
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gbc.gridx = 3; 

gbc.gridy = 7; 

gbc.gridwidth = 2; 

gbc.gridheight = 4; 

gbc.insets = new Insets(5,5,5,5); 
gbc.ipadx = 20; 

gbc.ipady = 20; 
gbl.setConstraints(backward, gbc); 
butt.add(backward); 


main.add(butt, BorderLayout.CENTER); 
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/* | SETUP UPDATEABLE DISPLAY OF HEADING, LATITUDE & LONGITUDE 
DESIRED COURSE, LATITUDE & LONGITUDE 
PUSHBUTTONS TO COMMENCE NAV/UPDATE ACTION AND STOP NAV */ 


JLabel labell = new JLabel("ACTUAL "); 
gbcon.gridx = 0; 
gbcon.gridy = 3; 
gblay.setConstraints(labell, gbcon); 
q.add(label1); 


JLabel label2 = new JLabel("ORDERED"); 
gbcon.gridx = 0; 
gbcon.gridy = 4; 
gblay.setConstraints(label2, gbcon); 
q.add(label2); 


JLabel label3 = new JLabel("Latitude:"); 
gbcon.gridx = 1; 
gbcon.gridy = 0; 
gblay.setConstraints(label3, gbcon); 
q.add(label3); 


JLabel label4 = new JLabel("(i.e. 03,06.1234,N)"); 
gbcon.gridx = 1; 
gbcon.gridy = 1; 
gblay.setConstraints(label4, gbcon); 
q.add(label4); 


JLabel label5 = new JLabel("Longitude:"); 
gbcon.gridx = 2; 
gbcon.gridy = 0; 
gblay.setConstraints(label5, gbcon); 
q.add(label5); 


JLabel label6 = new JLabel("(i.e. 067,09.9876,W)"); 
gbcon.gridx = 2; 
gbcon.gridy = 1; 
gblay.setConstraints(label6, gbcon); 
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q.add(label6); 


JLabel label7 = new JLabel(" Course:"); 
gbcon.gridx = 3; 
gbcon.gridy = 0; 
gblay.setConstraints(label7, gbcon); 
q.add(label7); 


JLabel label8 = new JLabel(" (Integer 0 to 360)"); 
gbcon.gridx = 3; 
gbcon.gridy = 1; 
gblay.setConstraints(label8, gbcon); 
q.add(label8); 


lat = new JTextField(20); 
gbcon.gridx = 1; 
gbcon.gridy = 3; 
gblay.setConstraints(lat,gbcon); 
q.add(lat); 

lat.setEditable(false); 


longi = new JTextField(20); 

gbcon.gridx = 2; 

gbcon.gridy = 3; 

gblay.setConstraints(longi,gbcon); 

q.add(longi); 
longi.setEditable(false); 


head = new JTextField(6); 

gbcon.gridx = 3; 

gbcon.gridy = 3; 

gblay.setConstraints(head, gbcon); 

q.add(head); 
head.setEditable(false); 


DLat = new JTextField(20); 

gbcon.gridx = 1; 

gbcon.gridy = 4; 

gblay.setConstraints(DLat,gbcon); 

q.add(DLat); 
DLat.setEditable(true); 


DLong = new JTextField(20); 
gbcon.gridx = 2; 
gbcon.gridy = 4; 
gblay.setConstraints(DLong,gbcon); 
q.add(DLong); 
DLong.setEditable(true); 


Dcourse = new JTextField(6); 
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gbcon.gridx = 3; 

gbcon.gridy = 4; 

gblay.setConstraints(Dcourse,gbcon); 

q.add(Dcourse); 
Dcourse.setEditable(true); 


autonomous.add(q, BorderLayout.NORTH); 


JLabel label9 = new JLabel(" Robot Status "); 
gbcon.gridx = 0; 
gbcon.gridy = 0; 
gblay.setConstraints(label9, gbcon); 
p.add(label9); 


RobotStatus = new JTextField(25); 

gbcon.gridx = 0; 

gbcon.gridy = 1; 
gblay.setConstraints(RobotStatus,gbcon); 

p.add(RobotStatus); 
RobotStatus.setEditable(false); 


autonomous.add(p, BorderLayout.SOUTH); 


JButton Update = new JButton(" Update "); 
gbcon.gridx = 0; 
gbcon.gridy = 0; 
gblay.setConstraints(RobotStatus,gbcon); 
s.add(Update); 


JButton Go = new JButton(" Navigate "); 
gbcon.gridx = 1; 
gbcon.gridy = 0; 
gblay.setConstraints(RobotStatus,gbcon); 
s.add(Go); 


JButton StopNav = new JButton(" Stop Navigation "); 
gbcon.gridx = 0; 

gbcon.gridy = 3; 
gblay.setConstraints(RobotStatus,gbcon); 

s.add(StopNav); 


Update.addActionListener( 
new ActionListener() { 
public void actionPerformed(ActionEvent ev) { 


/IGET NEW HEADING, LATITUDE AND LONGITUDE 
/INETWORKING for CLIENT/SERVER 


try { 
Headsock = new Socket("131.120.101.81", 2001); 
HeadIn = new BufferedReader(new InputStreamReader(Headsock.getInputStream())); 
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HeadOut = Headsock.getOutputStream(); 
} catch (Exception ex) { 
System.err.printIn("Could not connect to "+ "131.120.101.81" +". Quitting."); 
System.exit(0); 


try { 
inHead = (HeadIn.readLine()); 
} catch (Exception ex) {} 


/[UPDATE COURSE TEXTBOX 


inHead = inHead.substring(1,4); 
head.setText(inHead); 


/INET WORKING for CLIENT/SERVER 


try { 
GPSsock = new Socket("131.120.101.81", 2002); 
GPSIn = new BufferedReader(new InputStreamReader(GPSsock.getInputStream())); 
GPSOut = GPSsock.getOutputStream(); 
} catch (Exception ex) { 
System.err.printIn("Could not connect to "+ "131.120.101.81" +". Quitting."); 
System.exit(0); 
} 
try { 
inGPS = (GPSIn.readLine()); 


} catch (Exception ex) {} 


/! CHECK FOR A GOOD GPS HIT THEN UPDATE TEXTBOXES 


int GPSlength = inGPS. length); 
if(GPSlength > 92){ 
inlat = inGPS.substring(24,36); 
inlongi = inGPS.substring(37,50); 


lat.setText(inlat); 
longi.setText(inlongi); 
} 

else{ 
lat.setText(nohit); 
longi.setText(nohit); 


} 


Go.addActionListener( 
new ActionListener() { 
public void actionPerformed(ActionEvent ev) { 
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/TRETRIEVE DESIRED COURSE or GPS POSITION 


StrDHead = Dcourse.getText(); 

StrDLat = DLat.getTextQ); 

StrDLong = DLong.getText(); 

StrDHeadLoc = "x," +" "+ StrDHead + "," + StrDLat + "," + StrDLong; 


{UPDATE ROBOT STATUS WINDOW 


if(StrDHeadLoc.length0<5) 
RobotStatus.setText(NA); 
else 
if(SttDHeadLoc.lengthQ)<8) 
RobotStatus.setText(HO); 
else 
RobotStatus.setText(NAV); 


/ISEND DHeadLoc DATA 


try { 
DHeadLocsock = new Socket("131.120.101.81", 2003); 


DHeadLoclIn = new BufferedReader(new InputStreamReader(DHeadLocsock.getInputStream())); 
DHeadLocOut = DHeadLocsock.getOutputStream(); 

} catch (Exception ex) { 
System.err.printIn("Could not connect to "+ "131.120.101.81" +". Quitting."); 
System.exit(0); 

} 


try { 
DHeadLocOut.write((StrDHeadLoc + "\n").getBytes()); 
} catch (Exception ex) {} 


} 


StopNav.addActionListener( 
new ActionListener() { 
public void actionPerformed(ActionEvent ev) { 


/ISEND STOP SIGNAL 
//SETUP INITIAL COMMS ON STOP PORT 
try { 
StopNavsock = new Socket("131.120.101.81", 2004); 
StopNavIn = new BufferedReader(new InputStreamReader(StopNavsock. getInputStream())); 
StopNavOut = StopNavsock.getOutputStream(); 
} catch (Exception ex) { 
System.err.printIn("Could not connect to "+ "131.120.101.81" +". Quitting."); 
System.exit(0); 
} 
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/*This section creates the Buttons which will allow the user 
to choose between pre-programmed patterns. */ 


/[PATTERN 1 
JButton pattern! = new JButton("Pattern 1"); 
pattern! .addActionListener( 
new ActionListener() { 
public void actionPerformed(ActionEvent ev) { 


doPattern1(); 


} 
))s 
gbcon.gridx = 0; 
gbcon.gridy = 1; 
gblay.setConstraints(patternl, gbcon); 
s.add(pattern 1); 


//PATTERN 2 
JButton pattern2 = new JButton("Pattern 2"); 
pattern2.addActionListener( 
new ActionListener() { 
public void actionPerformed(ActionEvent ev) { 


doPattern2(); 


} 
ys 
gbcon.gridx = 1; 
gbcon.gridy = 1; 
gblay.setConstraints(pattern2, gbcon); 
s.add(pattern2); 


autonomous.add(s, BorderLayout.CENTER); 
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/* 

VideoStream vid = new VideoStream("file:SE3015.mpg"); 

main.add(vid, BorderLayout.SOUTH); 
7 | 
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/* Tabs are created to display three windows: Control window, Auto window 
and Status window */ 
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/ITABS SUBROUTINE 
mainPanel.add(tabs, BorderLayout.CENTER); 


tabs.addTab("Manual Control", main); 
// — tabs.addTab("Control", new JTextArea()); 


tabs.addTab("Robot Location", autonomous); 
tabs.addTab("Status", new JScrollPane(list)); 


setContentPane(mainPanel); 
pack(); 


} 


/* This function sends the commands to move through pattern! */ 


public void doPattern1() 
{ 


leftMotor.setValue(FORWARD); 
rightMotor.setValue(FORWARD); 


try { 

// 1000 milliseconds == one second 
Thread.sleep(3000); 
} catch (InterruptedException e){ } 


leftMotor.setValue(FORWARD); 
rightMotor.setValue(REVERSE); 


try { 
Thread.sleep(3000); 
} catch (InterruptedException e){ } 


leftMotor.setValue(STOP); 
rightMotor.setValue(FORWARD); 


try { 
Thread.sleep(3000); 
} catch (InterruptedException e){ } 


leftMotor.setValue(REVERSE); 
rightMotor.setValue(STOP); 


try { 
Thread.sleep(3000); 
} catch (InterruptedException e){ } 


leftMotor.setValue(FORWARD); 
rightMotor.setValue(FORWARD); 


try { 
Thread.sleep(3000); 
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} catch (InterruptedException e){ } 


leftMotor.setValue(FORWARD); 
rightMotor.set Value(REVERSE); 


try { 
Thread.sleep(3000); 


} catch (InterruptedException e){ } 


leftMotor.set Value(STOP); 
rightMotor.setValue(STOP); 


} 
/* This function sends the commands to move through pattern2 */ 


public void doPattern2() { 
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/*This section handles exceptions to the program */ 


public void terminate() { 
try { 
sock.close(); 


} 


catch (Exception ex) {} 
System.exit(0); 
} 


public static void main(String args[]){ 
if (args.length != 1) { 
System.err.println("usage: java RobotControl <ip address>"); 
System.exit(0); 
} 
RobotControl url = new RobotControl(args[0]); 
url.setVisible(true); 
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THIS PAGE INTENTIONALLY LEFT BLANK 
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APPENDIX C. WEB PAGE IN HTML 


PAGE 1 


<html> 

<head> 

<meta http-equiv="Content-Language" content="en-us"> 

<meta http-equiv="Content-Type" content="text/html; charset=windows-1252"> 
<meta name="GENERATOR" content="Microsoft FrontPage 4.0"> 

<meta name="ProgId" content="FrontPage.Editor.Document"> 

<title>New Page I</title> 

</head> 

<body> 

<p align="center"><img border="0" src="Flag.gif" width="100" height="55"></p> 


<p __align="center"><img —_ border="0" src="NPSeal.gif" width="505" 


align="left"></p> 


<p align="center"><img border="0" = src="Herrmann.jpg" ~— width="325" 


align="left"></p> 


<p align="center">&nbsp;</p> 
<p align="center">&nbsp;</p> 
<p align="center">&nbsp;</p> 
<p align="center">&nbsp;</p> 
<p align="center">&nbsp;</p> 
<p align="center">&nbsp;</p> 
<p align="center">&nbsp;</p> 
<p align="center">&nbsp;</p> 
<p align="center">&nbsp;</p> 


<p align="center">&nbsp; 


<Center> 

<table border=10 cellpadding=0 cellspacing=0> 

<tr><th nowrap> 

<img align=center src="comsys.gif"> 

<img border=1 align=center src="physicscard.gif" alt="Our business card" 
width=270 height=150 > 

<img align=center src="nps.gif"></th></tr> 


<p align="center">&nbsp;</p> 
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height="111" 


height="183" 


</table> 
</center> 
<p align="center">&nbsp;</p> 


<p align="center"><b><span style="mso-bidi-font-size: 10.0pt; mso-fareast-font-family: Times 
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